package ia.programasPrueba;

import lejos.robotics.navigation.DifferentialPilot;
import ia.util.Connector;
import ia.util.CreadorPiloto;


public class ClaseEjemplo {

	
	public static void main (String[] aArg){
	
	//Conectar, si no se puede terminar.
	boolean res = Connector.connectBT();
	if(!res) return;
	
	//Se crea el piloto
	final DifferentialPilot pilot = CreadorPiloto.getPilot();
	
	pilot.setRotateSpeed(40);
	pilot.setTravelSpeed(pilot.getMaxTravelSpeed()*0.3);	
	
	System.out.println("Avanza 15.");
	pilot.travel(15.0);
	System.out.println("Gira derecha.");
	pilot.rotate(-90);
	System.out.println("Avanza 15.");
	pilot.travel(15.0);
	System.out.println("Gira derecha.");
	pilot.rotate(-90);
	System.out.println("Avanza 15.");
	pilot.travel(15.0);
	System.out.println("Gira derecha.");
	pilot.rotate(-90);
	System.out.println("Avanza 15.");
	pilot.travel(15.0);
	System.out.println("Gira derecha.");
	pilot.rotate(-90);
	System.out.println("Avanza 5.");
	pilot.travel(5.0);
	System.out.println("Gira izquierda.");
	pilot.rotate(90);
	System.out.println("FIN.");
	pilot.stop();
	
	}
	
	
}
